function z = cal_len(x,y)
    z=sqrt((x(2)-x(1))^2+(y(2)-y(1))^2);
end